#include "data_struct/base/DataSet.h"
#include "modules/MonitorModule/BatteryMonitor.h"
#include "modules/CtrlModule/ActivePlanner/StationReturnPlanner.h"

namespace  behavior_controller
{
    #define MAX_BRUSH_POWER 200
    #define BRUSH_SPEED 0.2
    #define MAX_CURRENT 2
    BatteryMonitor battery_monitor;
    void BatteryMonitor::run()
    {
        if(station_return_planner.finished)
        {
            if(DataSet::battery_data.GetPercentage()< 0.2)
            {
                DataSet::ctrl_state = BRUSH_WINDER_PLAN;
                station_return_planner.finished=false;
            }  
        }
    }
}